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ABSTRACT 



The number of coordinates needed to completely describe the configuration of a 
holonomic mechanical system is equal to the number of degrees of freedom possessed 
by that system. In contrast, nonholonomic systems always require more coordinates 
for their description than their are degrees of freedom due to the nonintegrable nature 
of the governing velocity constraints. The task of nonholonomic motion planning 
applied to a given system is to develop trajectories of the independent coordinate 
variables such that the entire system is driven to some desired point in its config- 
uration space. An algorithm for constructing these trajectories is presented. In 
this algorithm, the independent variables are first converged to their desired values. 
The dependent variables are subsequently converged using closed trajectories of the 
independent variables. The requisite closed trajectories are planned using Stoke’s 
Theorem which converts the problem of finding a closed path in the space of the 
independent variables to that of finding a surface area in that same space such that 
the dependent variables converge to their desired values as the independent variables 
traverse along the boundary of the surface area. The use of Stokes Theorem simpli- 
fies the motion planning process and also answers important questions pertaining to 
the system. The salient features of the algorithm are apparent in the two examples 
discussed; a planar space robot and a disk rolling without slipping on a flat surface. 
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I. INTRODUCTION 



This thesis presents an algorithm for planning the motion of nonholonornic me- 
chanical systems. The algorithm provides a means for calculating the coordinate 
trajectories required to drive a nonholonornic system from one point in its configu- 
ration space to some other desired point. The algorithm involves the use of Stoke’s 
Theorem and therefore takes a surface integral approach to the problem. To enhance 
the reader’s understanding of the algorithm, the discussion proceeds methodically. 
The goal of this first chapter is to clarify the nonholonornic motion planning problem 
and provide a conceptual overview of the surface integral approach to its solution. 
Chapter II. begins with a review of the mathematical details needed for a complete 
understanding of the algorithm, follows with a detailed discussion of the algorithm 
itself, and concludes with some notes on some of its more versatile features. In 
Chapter III., the surface integral algorithm is applied to two simple nonholonornic 
mechanical systems; a planru' space robot and a disk rolling without slipping on a 
flat surface. These examples serve to validate the algorithm and, hopefully, solidify 
the reader’s understanding of it. Finally, a summary is provided in Chapter IV. It is 
hoped that this methodical approach will provide the reader with an appreciation for 
the simplicity and utility of the surface integral algorithm for the motion planning of 
nonholonornic mechanical systems. 

A. HOLONOMIC VERSUS NONHOLONOMIC SYSTEMS 

The description of mechanical systems begins with a suitable choice of coordinates 
and an identification of the constraints of motion resulting from that choice. In 
the case of holonomic mechanical systems, coordinates can be chosen such that no 
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motion constraints arise. When the coordinates are chosen such that constraints of 
motion do arise, those constraints always entail a relationship between the coordinates 
themselves and not their derivatives. In contrast, nonholonomic mechanical systems 
always require constraints of motion to complete their description regardless of how 
the coordinates are chosen. This is because at least one of the constraints will involve a 
non-integrable relationship between the first derivatives of the coordinates. To further 
illustrate the difference between holonomic and nonholonomic mechanical systems, 
consider the two systems shown in Figs. 1(a) and 1(b). 

Figure 1(a) shows two particles mi and m2 connected by a rigid, massless rod of 
length (h + 12] on a two dimensional x-y plane. The center of mass of the system is 
shown. An infinite number of coordinate sets can be used to describe the configuration 
of this system. One choice might involve the use of the coordinates {xc,yc, 0 ) to specify 
the position of the center of mass of the system in the x-y plane and the orientation 
of the rod with respect to the vertical y axis. Such a choice completely describes the 
state of the mass-rod system and does not require any equations of constraint. A 
second choice of coordinate sets might involve the coordinates (xi,yi,x2,y2) to specify 
the positions of each mass in the x-y plane. Such a choice of coordinates requires the 
following constraint equation in order to completely describe the state of the system; 

(12 — xi)^ -I- (3/2 ~ 2/1)^ = (h + ^2)^ (1) 

A third choice of coordinate sets might entail the coordinates (xi,yi,x2,y2.Xc,j/c) to 
specify the positions of each mass as well as the center of mass in the x-y plane. Such 
a choice of coordinates requires three equations of constraint to completely describe 
the system: 



(Xc - Xi)^ + [yc -yi)^ = l\ 


(2a) 


(X 2 - Xcf -i- (V2 - Vcf = 


(2b) 



2 



(X2 - Xi)^ -t (j/2 - 2/l)^ = (/l + 17 )^ 



(2c) 



Obviously, the possible number of coordinate sets that might be chosen to describe 
this system are endless. However, all possible coordinate sets share one common 
feature: they result in either no constraints of motion or constraints of motion which 
relate the coordinates of the system and not their derivatives. Hence, the rod-mass 
system of Fig. 1(a) is a holonomic mechanical system. 

Consider now the system shown in Fig. 1(b). This system consists of a disk of 
radius r rolling without slipping on the x-y plane. A set of coordinates which might 
be chosen to describe the location of a point P on the disk is (x,y,0.a) where x and y 
describe the location of the disk’s point of contact with the ground, 0 describes the 
angle a radial line through point P makes with the vertical z axis, and q describes the 
angle the disk’s instantaneous direction of motion on the x-y plane makes with the 
horizontal y axis. Such a choice of coordinates results in the following two equations 
of constraint: 

X = r^sin a (3a) 

y = r^cosa (3b) 

Note that Eqs.(3a) and (3b) above relate the derivatives of the coordinates to each 
other and not the coordinates themselves. Furthermore, since a is an independent 

I 

function of time, Eqs.(3a) and (3b) cannot be integrated to yield relationships be- 
tween the coordinates (the conditions for nonintegrability of a differential expression 
will be discussed in Chapter II. A. 1). For this reason, Eqs.(3a) and (3b) are termed 

nonholonomic constraints on the disk of Fig. 1(b), and the disk itself is said to be a 

nonholonomic mechanical system. All nonholonomic mechanical systems share this 
feature: the constraints of motion relate the velocities of the system and cannot be 
integrated to yield relationships between the coordinate positions. 
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This feature of nonholonomic systems is unique and gives rise to the nonholonomic 
motion planning problem. 

B. THE NONHOLONOMIC MOTION PLANNING PROBLEM 

In the previous section, it was shown that nonholonomic mechanical systems are 
governed by constraints of motion which involve nonintegrable relationships between 
the velocities of the system. In this section, it will be shown how this feature of 
nonholonomic systems gives rise to the nonholonomic motion planning problem. To 
understand this problem, a number of terms must first be discussed. 

The configuration space of a mechanical system is the space defined by the mini- 
mum number of coordinates needed to completely describe that system. The dimen- 
sion of the configuration space is the number of those coordinates. The degrees of 
freedom of a mechanical system is defined as the difference between the number of 
coordinates used to describe the system and the number of independent equations of 
constraint arising from that description. In more specific terms, given a mechanical 
system described by n coordinates and m independent equations of constraint, the 
number of degrees of freedom possessed by the system is equal to n - m. The number 
of degrees of freedom possessed by a given system is a fixed number and is completely 
independent of the coordinate system chosen. Finally, the number of independent co- 
ordinates available to a given mechanical system is synonomous with the number of 

' I 

degrees of freedom of the system. Additional coordinates over and above this number 
are always dependent. 

Consider now the holonomic rod-mass system of Fig. 1(a). Note that it is a three 
degree of freedom system since, regardless of how the coordinates are chosen, the 
number of coordinates minus the number of independent constraints is always equal 
to three. Likewise, the number of independent coordinates available to the system 
is also equal to three although for any given set of coordinates, the choice of which 
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are independent and which are dependent is both physically and mathematically 
arbitrary. NW consider the nature of the holonomic constraints described by Eqs.(l), 
(2a), (2b), and (2c). Note that because these equations all entail a direct relationship 
between the coordinates themselves, specification of the values of any three of the 
variables uniquely determines the values of any remaining variables. In other words, 
regardless of which coordinate system is chosen, specification of the values of the 
independent coordinates uniquely determines the value of the dependent coordinates. 
As a result, only the values of the independent coordinates are needed in order to 
completely specify the configuration of the system. This is true of all holonomic 
mechanical systems and because the number of independent coordinates available to 
a given system is equal to the number of degrees of freedom possessed by that system, 
the dimension of the configuration space of a holonomic system is always equal to its 
number of degrees of freedom. 

Now consider the nonholonomic rolling disk of Fig. 1(b) and its accompanying 
constraint equations, Eqs.(3a) and (3b). Note that it is a two degree of freedom sys- 
tem since the number of coordinates used to describe the system minus the number 
of independent equations of constraint is equal to two. The coordinates x and y are 
clearly the dependent variables since their values can only be changed by either rolling 
or both rolling and turning the disk. Note however that the values of x and y are not 
uniquely determined by the constraint equations given the values of the independent 
variables 0 and a. This is due to the fact that the constraint equations represent non- 
integrable relationships between the velocities of the system and not the coordinates 
themselves. As a result, the values of all four coordinates must be specified sepa- 
rately in order to completely describe the configuration of the rolling disk. Unlike the 
holonomic constraint equations of the rod-mass system, the nonholonomic constraint 
equations of the rolling disk do not restrict the dimension of the configuration space 
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of the system. This is a unique feature of nonholonomic mechanical systems and 
forms the heart of the nonholonomic motion planning problem: their ability to access 
a configuration space of higher dimension than their number of degrees of freedom. 
The nonholonomic motion planning problem can therefore be stated as follows: given 
a system described by n coordinates and m nonholonomic constraints, how does one 
drive all n of the coordinates from some initial set of values to some desired set of 
values in spite of the system having only n - m degrees of freedom? The answer to 
this question has been sought by numerous reseairchers and a variety of solutions have 
been proposed. In the next section, a brief survey of some of these solution techniques 
will be presented. 

C. LITERATURE SURVEY 

The nonholonomic motion planning problem has been the focus of attention of 
various researchers in the recent past. Specifically, researchers have considered the 
questions of how a falling cat manages to always land on its feet [Ref. 1, Ref. 2: 
pp. 25-30] and how an astronaut might use those same principles to reorient himself 
during a spacewalk [Ref. 3|. Researchers have also considered the problems of mobile 
wheeled robot navigation [Ref. 4, Ref. 5], parking a front wheel drive car [Ref. 2: 
pp. 89-91, Ref. 6: pp. 8-11, Ref. 7: pp. 17-19], parking a cart with multiple trailers 
[Ref. 6: pp. 11-13, Ref. 7: pp. 29-30, Ref. 8], controlling a unicycle or rolling disk 
[Ref. 2: pp. 83-89, Ref. 6: pp. 6-8], controlling a satellite with rotors instead of 
gas jets [Ref. 2: pp. 21-25], dextrous manipulation with robotic fingers [Ref. 9], and 
reconfiguration of a space structure or space manipulator using only internal motion 
[Ref. 10, Ref. 11]. Each of these researchers have explored various aspects of the 
nonholonomic motion planning problem and have developed unique solutions to it. 

Kane, Headrick, and Yatteau [Ref. 3] conducted experiments to determine the 
feasibility of a spacewalking astronaut to reorient himself through arm motion only. 
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The nonholonomy of an astronaut or any freefloating spacecraft derives from the prin- 
ciple of angular momentum conservation. While these researchers did not approach 
this problem in the broad context of nonholonomic motion planning, their research 
pointed the way towards a number of possible solution techniques. 

The problem of controlling a multi degree of freedom space manipulator was first 
addressed by Vafa and Dubowsky [Ref. 11]. The dynamic coupling between the 
joints of a space manipulator and the vehicle to which it is attached often results in 
an undesirable drift of the vehicle when the joints are actuated. Vafa and Dubowsky 
proposed using small cyclic motions of the manipulator joints to control this drift. 
The problem was also tackled by Nakamura and Mukherjee [Ref. 10] who showed 
that the vehicle orientation as well as the joint angles could be brought to their 
desired configurations by executing appropriate trajectories of the joint angles. The 
trajectories were planned using a Lyupanov function and by adopting a bidirectional 
approach. 

The nonholonomic nature of a car or cart with multiple trailers evolves along the 
same lines as that of the rolling disk discussed in the previous sections. Laumond [Ref. 
8] studied the multibody car system and concluded its controllability by showing that 
the rank of the control Lie Algebra is equal to the dimension of the state space at 
every point in the state space. Murray and Sastry [Ref. 7: pp. 29-30] also studied the 
problem. They showed that the dependent variables of the system could be brought 
to their desired values by executing closed trajectories of the independent variables. 
The closed trajectories were planned using a scheme involving sinusoids. 

While the research discussed above sheds light on various aspects of the non- 
holonomic motion planning problem, none of the methods, algorithms, or concepts 
developed thus far completely solve the problem. A general scheme, applicable to a 
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wide range of nonholonomic mechanical systems, has not yet been presented. Addi- 
tionally, a global scheme for addressing important questions such as motion planning 
in the presence of additional constraints, the reachability of a given system, and re- 
peatability is conspicuously absent from the literature. The surface integral algorithm 
represents a new approach. Not only is it applicable to a large class of nonholonomic 
systems, but its implementation also leads to definitive answers to the questions posed 
above. In the next section, a conceptual overview of the algorithm will be presented. 
D. OVERVIEW OF THE SURFACE INTEGRAL ALGORITHM 

To gain a basic understanding of the surface integral approach to the motion 
planning of nonholonomic systems, consider again the rolling disk, this time shown 
in Fig.2(a). Suppose it is desired that the disk change its coordinates from [x,y,9,a) 
to {xd,yd,6,a). A very simple way of accomplishing this would be to first roll the 
disk forward along path segment AO, and then roll the disk backwards along path 
segment OB. As shown in the figure, the end result of such a maneuver would be 
that the coordinates 6 and a remain constant while the coordinates x and y move to 
their desired values x^ and yd. Such an operation involves the execution of a dosed hop 
trajectory in the 9-a plane , shown in Fig. 2(b), to achieve the desired change in x and 
y. In more general terms then, it appears as though it is possible for nonholonomic 
mechanical systems to achieve a desired configuration of the dependent variables 
simply by executing an appropriate closed loop path in the space of the independent 
variables. It therefore follows then, that to converge all of the configuration variables 
of a nonholonomic system from one set of values to another, one might first converge 
the independent variables from their initial values to their desired values without 
being concerned about the evolution of the dependent variables. One could then 
execute an appropriate closed loop path in the space of the independent variables to 
converge the dependent variables to their desired values. 
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The technique described above leaves one critical question unanswered. How does 
one calculate an appropriate closed loop path? The surface integral algorithm is the 
answer. In this method, the problem of finding a closed loop path in the space of 
the independent variables is transformed into the problem of determining a surface 
area in that same space such that the dependent variables converge to their desired 
values as the independent variables traverse around the boundary of the surface area. 
The required transformation is accomplished by applying Stoke’s Theorem to the 
differential form of the nonholonomic constraint equations. 

To summarize, the essential features of the surface integral algorithm for the 
motion planning of nonholonomic systems can be stated as follows: all of the config- 
uration variables of a nonholonomic mechanical system are brought to their desired 
values by first converging the independent variables and then by executing a closed 
loop path in the space of the independent variables to converge the dependent vari- 
ables. The requisite closed loop path is calculated by applying Stoke’s Theorem to 
the differential form of the nonholonomic constraint equations. 

In the next chapter, Stoke’s Theorem and other mathematical details needed for 
a full understanding of the surface integral algorithm will be reviewed. Following 
that, a detailed mathematical description of the surface integral algorithm will be 
presented. Finally, the algorithm’s ability to answer important questions pertaining 
to the system will be discussed. 
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II. THE SURFACE INTEGRAL APPROACH TO THE 
NONHOLONOMIC MOTION 
PLANNING PROBLEM 



A. MATHEMATICAL PRELIMINARIES 

1. Nonintegrability of Nonholonomic Constraints 

In Chapter I., nonholonomic constraints were described as constraints which 
involved a nonintegrable relationship between the first derivatives of the coordinates. 
An obvious question is how does one determine whether or not a given constraint is 
nonintegrable? To answer, the constraint equation must first be recast into differential 
form. Taking the constraint described by Eq.(l) for example, and differentiating with 
respect to time yields 



(x2 - xi)(x2 - xi) + (v2 - yi)(2/2 - 2/1) = 0 

Rewriting in differential form and designating X 2 as the dependent variable yields 



(X2 -xi)(dx2 -dxi) + (y2 - yi)(<iy2 - dyi) = 0 

dx-2 = (— — —)dy2-{— — —)dyi-\-dx), (4) 

X2 ^ X2 — X\ 

Equation (4) represents the constraint described by Eq.(l) recast into differential 
form. 

Recasting the nonholonomic constraints of the rolling disk into differential 
form is a simpler task. 



X = rOsina 


— ' 


dx = (rsina)(i^ 


( 5 a) 


y = rO cos a 





dy = {r sin a)dd 


( 5 b) 
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The above discussion helps to illustrate the fact that any set of constraint 
equations, be they holonomic or nonholonomic, can be written in the following general 
form 

n 

^ Oj, (f< 7 . + Uj, dt = 0, j = l,2, • • ■rn (6) 

t=i 

where the q’s represent the generalized coordinates, t represents time, and the as are, 
in general, functions of the q’s and t. In Eqs.(4), (5a), and (5b) the time coordinate 
does not appear explicitly. This is a property of what are termed scleronomic systems, 
and only mechanical systems of this type will be considered in this discussion. As 
before, n represents the number of generalized coordinates used to describe the system 
and m represents the number of independent constraint equations. 

With the constraint equations in differential form, a simple test can be ap- 
plied to determine whether or not the equations are integrable. Strictly speaking, a 
differential expression is integrable if and only if it is an exact differential or can be 
converted into an exact differential by multiplying through with an integrating factor. 
In, more specific terms, it can be shown that the necessary and sufficient condition 
for the integrability of the differential expression 



vidx + V2cly + v^dz = 0 



(7a) 



where vi, v^, and vs are continuous functions of x, y, and z in a domain D of space is 



that 







+ Vs 







(76) 



In the more general case, the necessary and sufficient condition that the differential 
constraint in n variables 



Vi dxi + Vs dxs + • • • + Vn dxn — 0 



(8a) 
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is integrable is that the set of equations 



IV 









= 0 



(A, 1,2, 



( 86 ) 



are satisfied simultaneously and identically. [Ref. 12) 

Applying this criterion to Eq.(4) shows that this constraint is in fact integrable 
and therefore holonomic. Applying this criterion to Eqs.(5a) and (5b) shows that they 
are not integrable and therefore nonholonomic. 

2. Relevant Theorems 

In this part of the chapter, two important mathematical theorems will be 
reviewed. The first is Stoke’s Theorem used for the transformation of line integrals 
into surface integrals and vice versa. The second concerns the path independence 
of line integrals. Stoke’s Theorem will serve as the principal mathematical tool for 
determining the required closed loop path needed to converge the dependent variables. 
The theorem regarding the path independence of line integrals will be crucial to the 
demonstration that the dependent variables can in fact be driven to any desired 
configuration from 2Uiy other, 
a. Stoke’s Theorem 

Let 5 be a piecewise smooth oriented surface* in space and let the boundary 
of 5 be a piecewise smooth closed curve C. Let v(x, y, 2 ) be a continuous vector function 
which has continuous first partial derivatives in a domain in space which contains S. 

* If a surface S has a unique normal whose direction depends continuously 
on the points of S, then S is called a smooth oriented surface. If 5 is not smooth but 
can be subdivided into finitely many smooth portions, then it is called a piecewise 
smooth oriented surface. 
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Then 



^ i'tds = j j n^{Vxv)dA 



(9) 



where n is the vmit vector normal to the surface 5 on that side of S which is taken as 
the positive side. The positive direction along C is then defined as the direction along 
which an observer, travelling on the positive side of 5, would proceed in keeping the 
enclosed area to his left. Refer to Fig. 3(a). is the component of v in the direction 
of the tangent vector of C. [Ref. 13: p. 364) 

If the direction cosines of the unit vector n normal to the surface 5 are co«a, 
cos t?, and COS 7 , and if u = vii + v< 2 j + t’sfc, then Stoke’s Theorem can be written as 



y {v\ dx + v -2 dy + i ’3 dz) = 

If the space under consideration is restricted to the x-y plane, then Eq.(lO) simplifies 
to the form 

£{v,dx + v,dy} = I l^(^^-^'^dxdy (11) 

which is essentially a statement of Green’s Theorem [Ref. 13: p. 336). 

For Eq.(ll), the positive direction along the closed curve C is shown in 
Fig. 3(b). This directly follows from Eq.(lO) where the values of a, i3, and 7 were 
taken to be 7 t/ 2 , tt/ 2 , and 0 respectively. The direction of the closed curve C in 
Eq.(ll) may be changed by using (a,/?, 7 ) = (tt/ 2 , tt/ 2 , tt) in Eq.(lO). This will lead to 
a change in sign of the surface integral in Eq.(ll). 
b. The Path Independence of Line Integrals 

Let V = vii + v 2 j + vik, and let vi, v^, and vs be continuous functions of x, 
y, and 2 in a domain D of space. Then the line integral 

J {vidx + v^dy + vsdz) ( 12 ) 




dv^ dv2\ / ^ / ^^2 dvi 

— -—jcos.3+1 — - — 



cos 7 



dA 



( 10 ) 
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is independent of path if and only if the differential form under the integral sign is 
exact in D, or equivalently the integral is zero for every simple closed path in D, or 
equivalently V x v = 0 everywhere in D [Ref. 13: pp. 369-376]. 

From the above theorem, coupled with Eq.(lO), it is clear that the necessary 
and sufficient condition for the value of the line integral in expression (12) to be 
independent of the path C is that 

di'2 dt'3 dv3 dvi dv\ dv-2 

dz dy ’ dx dz ' dy dx 

B. THE SURFACE INTEGRAL ALGORITHM 

In Chapter I.D.. a conceptual overview of the surface integral approach to the 
motion planning of nonholonomic systems was presented. With the mathematical 
details necessary for a complete understanding of the algorithm now covered, a more 
detailed treatment of the method is in order. It should be noted that the algorithm is 
best illustrated through the use of appropriate examples. This will be the subject of 
Chapter III. At this point however, it is well worth the effort to discuss the theoretical 
and mathematical basis of the algorithm. 

Consider now a nonholonomic system where one of the dependent variables is p 
and is constrained by the nonholonomic differential expression 

dp — V xdx + v-idy ( 14 ) 

where x and y are taken to be the independent variables and vi and vi are general 
functions of x and y. 

If an attempt is made to integrate Eq.(14) along some closed curve C in x-y space 

<j> dp = (j) {vidx + v<2dy) ( 15 ) 

Jc Jc 

it is clear that the attempt would be a failure since nonholonomic constraints are, 
by definition, nonintegrable. However, since the expression on the right hand side of 
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Eq.(14) is not integrable, it is therefore not exact. It follows then, from the discussion 
on the path independence of line integrals, that i/such a curve C could be found and 
the integration performed, the resulting change in p would be dependent on the nature 
of C. In other words, the evolution of the dependent variable p as the independent 
variables x and y traverse a closed loop path in x-y space is entirely dependent on the 
shape of that path. It seems then, that a desired change in the value of the dependent 
variable p could be affected by choosing an appropriate path C in x-y space about 
which the independent variables x and y traverse. The obvious question is how might 
this path be chosen given the nonintegrable nature of Eq.(15). 

At this point, Stoke’s Theorem comes to the rescue. Suppose the desired change 
in p is given by Ap. Then, using Stoke’s Theorem (in the simplified form of Green’s 
Theorem), Eq.(15) can be recast into the following form: 




{v\dx + v^dy) 



-//.(S 



dy) 



dxdy = Ap 



(IGa) 



If the double integral of Eq.(16a) can be evaluated, then the problem of determining 
the appropriate closed curve C is reduced to finding a surface area S in which the 
curve C is defined by the outline of this surface area. The integration problem can be 
simplified by choosing this surface area to be rectangular in shape with sides parallel 
to the X and y axis. Placing limits on the double integral of Eq.(16a) results in 



Ap = 




dy) 



dxdy 



im 



where xi and x„ represent the lower and upper limits of the rectangle along the x 
axis and yi and y„ represent the lower and upper limits of the rectangle along the 
y axis. A simple way of solving this problem thus involves performing the double 
integration dictated by Eq.(16b), choosing three of the four required limits based 
on the physical considerations of the problem, and solving the resulting algebraic 
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expression for the fourth and final limit. With this information in hand, the closed 
curve C can be constructed and the independent variables x and y caused to traverse 
around it to produce the desired change in p. As stated in Chapter I.D., the complete 
surface integral algorithm involves first moving the independent variables to their 
desired values noting the resulting final values of the dependent variables and then 
calculating an appropriate closed loop path in the space of the independent variables, 
using the method described above, such that the desired change in the values of the 
dependent variables is brought about. 

This is the surface integral algorithm for planning the motion of nonholonomic 
systems. Its utility and ease of implementation is demonstrated via the examples to 
be discussed in Chapter III. Before proceeding to those examples however, it is worth 
noting some of the more salient features of the algorithm. 

C. NOTES ON THE VERSATILITY OF THE SURFACE INTEGRAL 
ALGORITHM 

The surface integral adgorithm provides a simple and effective means of deter- 
mining the trajectories required to drive all of the configuration variables of a non- 
holonomic mechanical system to their desired values. The following features of the 
algorithm make it particularly attractive. 

1. Location of the Closed Trajectory in the Space of the Independent 
Variables 

Once again, consider a nonholonomic system where one of the dependent vari- 
ables is p and is constrained by the nonholonomic differential expression 

dp = vidx + V2<iy + v^dz (17) 

where x, y, and ^ are taken to be the independent variables and vi, V 2 , and V 3 are gen- 
eral functions of x, y, and 2. Assume now that there exists some closed trajectory C of 



16 



the independent variables x, y, and z that produces a change in the dependent variable 
P by some desired amount Ap. If (xo.yo.-o) is any point on this closed trajectory, and 
if the initial configuration of the system is (xq, yo, zo.Po), then after the system moves 
along C once, its configuration will be (xo,yo, zo.po + Ap). Refer to Fig.4(a). If the 
closed curve C was traversed in the opposite direction, then the final configuration of 
the system would have been (xo.yo, zo.Po - Ap). Now consider the initial configuration 
of the system to be (x',y', z',po) such that (x',y', z') does not lie on C. Let P be any path 
segment connecting the point (x',y',z') and a point (xo,yo,zo) on the closed curve C. 
Refer to Fig. 4(b). Let 6p denote the change in the dependent variable p as i, y, and z 
move along the path segment P from (x',y',z') to (xo,yo,zo). Then, if the system moves 
from the initial configuration (x', y', z',po) to the closed curve C, traverses the closed 
curve C once, and finally retraces the path segment P backwards, the configuration 
of the system at the end of the path will be (x',y',z',po + Ap). This is true because 
the surface integral of the area bounded by the closed curve beginning and ending at 
the point (x',y',z') is equal to the surface integral of the area bounded by the closed 
curve C. From this discussion, it follows that the closed curve C that can bring about 
the desired change in the dependent variable can lie anywhere in the space defined 
by the independent generalized coordinates - it does not have to pass through the 
initial configuration of the system. This feature of the surface integral algorithm is 
extremely useful and will prove its worth in the example systems to be dicussed in 
Chapter III. 

2. Motion Planning in the Presence of Additional Constraints 

Often times, mechanical systems are subjected to constraints of motion over 
and above those arising from the choice of coordinates. Obstacles in the workspace 
provide the most salient example. The rolling disk of Figs. 1(b) and 2(a) for instance, 
might have its allowed motion restricted by a wall or similar obstacle. The motions 
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of a robot on an automobile assembly line must be planned so as to avoid inadvertent 
contact with the cars it is operating on. In order to be effective, a motion planning 
algorithm must allow for the generation of admissible trajectories in the presence of 
additional constraints. With regard to nonholonomic systems, the surface integral 
algorithm provides just such a capability. This capability will be demonstrated in the 
examples of Chapter III. 

3. Algorithmic Singularity 

Virtually all motion planning algorithms, when applied to any given mechan- 
ical system, entail the possibility of mathematical singularity. An effective algorithm 
must provide a means for coping with this problem when it arises. In Chapter III., 
the ability of the surface integral algorithm to deal with mathematical singularity will 
be readily apparent. 

4. Reachability 

The reachability of a given mechanical system can best be defined as its ability 
to arrive at any desired configuration firom any other. Obviously, the reachability of 
a system is an important consideration. Implementation of the surface integral al- 
gorithm provides a means of ascertaining the reachability of a nonholonomic system. 
In Chapter III., the general method of determining the reachability of a nonholo- 
nomic system will be discused and the method demonstrated via the examples of 
that chapter. 

5. Repeatability 

The basis of the surface integral algorithm derives from the fact that closed 
trajectories of the independent variables result in a change in the values of the de- 
pendent variables. In particular situations however, it may be desirable to find closed 
trajectories of the independent variables that result in no net change of the dependent 
variables. Motion of this type is termed repeatable motion due to the fact that all of 
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the coordinate variables return to their original values upon completion of the mo- 
tion. Robots programmed to perform repetitive tasks (such as automobile welding) 
for example, must be capable of repeatable motion in order to perform the same task 
over and over again. While the issue of repeatability is theoretically trivial in the case 
of holonomic systems, such is not the case for nonholonomic systems. In Chapter 111., 
it will be demonstrated that the trajectories needed to produce repeatable motion in 
a nonholonomic mechanical system can be generated easily through application of 
the surface integral algorithm. 

Thus far, this paper has presented a description of nonholonomic mechanical 
systems and the nonholonomic motion planning problem, the mathematical basis of 
the surface integral algorithm for solving the nonholonomic motion planning prob- 
lem, and a discussion of the surface integral algorithm itself. Additionally, the various 
attractive features of the algorithm have been briefly described. In the next chapter, 
the algorithm will be applied to two simple nonholonomic systems: a two dimensional 
free flying space robot and the rolling disk of Figs. 1(b) and 2(a). These two exam- 
ples will demonstrate the exceptional utility, simplicity, and versatility of the surface 
integral algorithm. 
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III. APPLIED EXAMPLES OF THE SURFACE 
INTEGRAL ALGORITHM 

A. THE PLANAR SPACE ROBOT 

In this part of Chapter III., the surface integral algorithm for the motion planning 
of nonholonomic systems will be illustrated through the example of a free flying, two 
dimensional space robot. The robot consists of two links mounted on a space vehicle 
as shown in Fig. 5. Such a system can be described by five coordinates: xq, yo, and 6q 
representing the position of the center of mass and the orientation of the space vehicle, 
and 9i and 9^ representing the joint angles of the manipulator. The requirement that 
the linear momentum of the system be conserved leads to two holonomic constraints of 
motion while angular momentum conservation leads to one nonholonomic constraint. 
Because the system is described by five coordinates and three equations of constraint, 
the planar space robot possesses two degrees of freedom. 

The holonomic constraints that arise due to the conservation of linear momen- 
tum allow for the elimination of the variables lo and yo from the kinematic equations 
describing the system. The nonholonomic constraint however, does not allow for the 
elimination of any of the variables due to the fact that it consists of a nonintegrable 
relationship between the derivatives of the remaining coordinates, namely 9o, 9i, and 
02- The entire system is therefore completely described by three generalized coordi- 
nates (^ 0 , ^ 1 .^ 2 ) and one nonholonomic constraint equation due to the conservation of 
angular momentum. With some effort, this nonholonomic constraint equation can be 
derived and is found to be given by the relation 

= 1 +602) ( 18 ) 
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where, 



^ = (x'^l + + 7^2^2 - {mo + 7^l)'n2/i/2 COS^2 ~ ( I + {-TTli + m2)/? + -m2ln 

I 4 2 y 4 ^ 4 



a = -A - A/ /o 



1 .9 1 



1 2>2 1 1 



b = M ( /2 + -rn 2/2 + 2 '” 2 h^ 2 COS 02 j - - 2 ’^ 2 ( 2 ^i + ’T^ 2 )h ^2 COS 02 ( 19 ) 



and where mo, mi and m2 are the masses of the space vehicle and the two links; /o, l\ 
and h are the moments of inertia of the space vehicle and the two links about their 
center of masses; /i and I2 are the length of the tw'o links; and M = (mo + mi + m2) and 
1 = (/o + fi + ^2)- 

The physical effect of the nonholonomic constraint described by Eq.(18) is that the 

orientation of the space vehicle, Oq, drifts when the joints are activated. Because the 

amount of drift is directly dependent on the motion of the joints, 60 is the dependent 

variable in the system. The nonholonomic motion planning task is therefore to develop 

trajectories of the independent variables 61 and 62 which drive the entire system to 

some desired configuration. In accordance with the procedure described in Chapter 

II. B., this will be accomplished by first converging the joint angles to their desired 

values. The orientation of the vehicle will then be converged by executing closed 

trajectories of the joints. These closed trajectories will be planned using Stoke s 

» 

Theorem. 

Let the arbitrary initial and desired configurations of the robot be denoted by 
{0(H,0u,02,) and {Oof,Oif,e2f) respectively. Upon initial convergence of the independent 
variables 6u and ^2« to their desired values 9 if and $2/, let the orientation of the 
space vehicle drift from % to some intermediate value 9 od. The task then is to use 
Stoke’s Theorem to plan a cyclic motion for the joints of the manipulator such that 
the orientation of the space vehicle changes from 9 od to 9 o/ while the joint angles come 
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back to their desired configuration. Rewriting Eq.(18) in differential form yields 



dBo 



— (adOi + bdO^) 



( 20 ) 



Integrating Eq.(20) about a closed curve C in the 9i-92 plane and applying Stoke’s 
Theorem in the form given by Eq.(ll) yields 



^ 0 / ~ ^od = ^ d.^0 — ^ ~ J J 



A(A)_ A(“) 

d9iA’ 69-2 a’ 



d9id92 



(21) 



where S is the surface in the 9i-92 plane confined within the closed curve C. Substi- 
tution of the expressions for a, h, and A from Eq.(19) and specification of the surface 
5 as a rectangle with sides parallel to the 9i and 92 axis leads to 

r^2u r^\ 



{00/ - 0 od) = MIo ^ 

Je,, Jeu ^^2 \A + Bcos92j 



( 22 ) 



where 



A = (^mi + m2)^/i + - A/ (^mi + mj)/^ + ^m2l'^ 

B = —{rriQ + -»Tii)m2h^2 (23) 



and where 9u and 9\^ denote the lower and upper extremities of 9^ in the rectangular 
path while ^ 2 / and $ 2 u denote the same for 92 - Finally, performing the combined 
differentiation and integration dictated by Eq.(22) yields 



^ = MIo {9iu-0u) 
n 



1 



1 



A B COS02U A-\- B cos $ 21 ^ 



( 24 ) 



where 



Oq = Oof ^ Ood 



and n equals the desired number of cyclic motions about the closed loop trajectory. 

Clearly, for a desired change in 9q (given by ^ 0 )^ ^ appropriate closed loop tra- 
jectory of the joint variables $i and 62 can be constructed simply by specifying the 
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trajectory to be rectangular in shape and choosing values of Ou, 0iu, O 21 , and $ 2 u such 
that Eq.(24) is satisfied. 

To illustrate, consider a robot with the following kinematic and dynamic param- 
eters; mo = 27.44 kg, mi = 5.38 kg, m 2 = 2.64 kg, /q = 1.520 kgm^, Ii - 0.115 kgm^, 
I 2 = 0.028 kgm^, h = 0.50 m, and h = 0.35 m. Let the initial configuration of the 
system be = (0.0,15.0,15.0) degrees and the final desired configuration be 

[Oof,O\f, 02 f) = (-20.0,45.0,0.0) degrees. Furthermore, specify that the desired change 
in the dependent v'ariable 60 occur only after three complete cycles of the closed loop 
trajectory. Using computer simulation, the independent variables 61 and 62 are first 
converged from their current values to their desired values by following the straight 
line trajectory OA shown in Fig. 6(a). During this process, the orientation of the 
space vehicle drifts from ^o, = 0.0 degrees to ^o<< = -12.87 degrees as shown in Fig. 6(b). 
Thus, ^0 = ^ 0 / - ^od = -7.13 degrees. If a cyclic motion of the joints is to be planned 
such that after three complete cycles the orientation of the space vehicle changes by 
the desired amount, then for each cycle the required change of orientation would be 
lo/n = -7.13/3.0 = -2.38 degrees. Choosing 0 u = 45.0 degrees and 621 - 0.0 degrees to 
correspond with point A of Fig. 6(a) and arbitrarily choosing = 125.0 degrees results 

in 02u = 53.4 degrees, calculated using Eq.(24). Note that all angles must be converted 
from degrees to radiams prior to using Eq.(24). 

The values (^u,^iu,02n^2u) = (45.0,125.0,0.0,53.4) degrees define a rectangular path 
ABCDA in the 61-62 plane, shown in Fig.6(a), which, when traversed three times by 
the robot joints, will cause the dependent variable 6 q to converge to its desired value. 
The evolution of all the configuration variables for the path O ABC DA when the closed 
trajectory ABCDA is traversed three times is shown in Fig. 6(b). Note that all of the 
configuration variables do in fact converge to their desired values. 
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The above example confirms the validity of the surface integral algorithm. It is 
now worth the effort to illustrate some of the more versatile features of the algorithm 
in the context of this example. 

In Chapter II. C. 2., it was noted that motion planning must often occur in the 
presence of additional constraints. Suppose now that a situation exists such that 
the following joint limit is imposed on the space robot: <90 degrees. Clearly, 

the closed trajectory ABCDA is no longer feasible since it requires 6x to come to a 
maximum value of = 125.0 degrees. Since this value was chosen arbitrarily to begin 
with, there is complete liberty to respecify it as, say, 0iu = 75.0 degrees. Taking Ou and 
9-21 to have the same values as before, maintaining the requirement that three complete 
cycles of the closed loop trajectory be executed, and recalculating the value of 
using Eq.(24) yields = 89.2 degrees. The values = (45.0,75.0,0.0,89.2) 

degrees define a revised rectangular path AEFGA shown in Fig.7(a) which, when 
traversed three times by the robot joints, will cause the dependent variable to 
converge to its desired value subject to the constraint |0i| < 90 degrees. The evolution 
of all the configuration variables for the path O AEFGA when the closed trajectory 
AEFGA is traversed three times is shown in Fig. 7(b). 

Now suppose yet another constraint is imposed, namely |^ 2 l < 80 degrees. This 

) I 

constraint now renders both the paths ABCDA and AEFGA infeasible. To obtain 
a feasible path, one might choose to respecify 0iu once again in order to obtain a 
suitable value for d^u- However, there is another way. If the requirement to execute 
three cycles of the closed trajectory is lifted, one would have the freedom to choose 
any number of cycles. Choosing the number of cycles to be n = 6 and maintaining 
{9u,9iu,92t) = (45.0,75.0,0.0) degrees yields ^ 2 u = 61.86 degrees. These values now define 
the path AHIJA shown in Fig.8(a) which, when traversed six times, will converge 
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restrict the available trajectories, it will still be possible to choose from a variety of 
paths that will produce repeatable motion. 

To illustrate this point, consider the initial configuration of the robot to again 
be {9q,,6u,02i) = (0.0,15.0,15.0) degrees. This time however, the task is to move the 
joints from their initial configuration to some desired configuration and back to their 
initial configuration without effecting any change in the value of ^o- Again choosing 
a rectangular trajectory for the joint variables and substituting the condition that 
^ 2 u + 921 = 2?r (letting n == l), recasts Eq.(24) into the following form: 



0 = A//o(^u-^i,) 



1 

B cos ^2u 



1 

A -f BcOs( 27T - ^2u) 



(27) 



If the desired configuration of the joints is given by (^i/,^ 2 /) = (60.0,30.0) degrees, and 
(9iu,92u) are chosen to be (60.0,30.0) degrees, then ^21 is calculated to be 2n -30.0 = 
330.0 = -30.0 degrees. Choosing 9u to be 15.0 degrees so that the initial configuration 
of the system lies on the planned closed loop path results in the trajectory OAKLMO 
shown in Fig.9(a). Assume now that the joints must perform the required task five 
times, each time moving from point O to point L and back again to O. The evolution of 
all the configuration variables as this is accomplished over the path OAKLMO is shown 
in Fig. 9(b). Note that the motion is completely repeatable. All of the configuration 
variables, including the vehicle orientation 9q, return to their initial values following 
each execution of the closed trajectory OAKLMO. 

In this first part of Chapter III., the surface integral algorithm was applied to 
the motion planning of a planar space robot. The example illustrated the validity 
of the algorithm as well as its ability to handle additional motion constraints. The 
example also demonstrated how the algorithm can be used to ascertain a particular 
system’s reachability. Finally, the algorithm was used to plan trajectories which result 
in repeatable motion of all the coordinates. In Chapter III.B., the algorithm will be 
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applied to yet another nonholonomic system, the rolling disk. This example will 
demonstrate the algorithm’s ability to avoid cases of singularity and will prove that 
the closed trajectory needed to converge the dependent variables can lie anywhere in 
the space of the independent variables. 

B. THE ROLLING DISK 

In this part of Chapter III., the surface integral algorithm will be applied to the 
motion planning of the rolling disk first mentioned in Chapter I. A.. This example 
will serv'e to further illustrate the algorithm itself as well as the algorithm’s ability to 
handle cases of algorithmic singularity. 

As discussed previously, the configuration of the rolling disk of Figs. 1(b) and (2) 
can be described by the coordinates (x,y,0,a) and the differential motion constraints 

dx = r sin add (28a) 

dy = r cos a d& (286) 

where x and y represent the dependent variables while 0 and a are taken as the 
independent variables. To plan a path from some initial configuration (a;,,y,, A,a.) to 
some desired configuration (xf,yf,0f,af), the surface integral algorithm requires that 
the independent variables first be converged to their desired values as the dependent 
variables evolve to some intermediate configuration (xd,yd)- A closed path in the 
space of the independent variables is then planned using Stoke’s Theorem such that 
the dependent variables converge from (xd,yd) to (x/,y/) as the independent variables 
travel along this closed path. Let C be such a closed path in the 0-a plane. Then the 
change of the variables x and y as 0 and q traverse this path is given by 



X f - ^ r sin a dO = J J a dO da 


(29) 


y f — Vd — ^ ^ cos a dO = J Jr sin a dO da 


(30) 
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the dependent variable 0o subject to the constraints l<?i| < 90 degrees and |<? 2 | < 80 
degrees. The evolution of the configuration variables for the path OAHU A is shown 
in Fig. 8(b). 

The above examples illustrate that using the surface integral algorithm to plan 
the closed trajectory of the independent variables needed to converge the dependent 
variable in the presence of additional constraints is a relatively trivial problem. One 
need only choose an appropriate value of 6iu or an appropriate number of cyclic 
motions of the joints. This feature of the surface integral algorithm is extremely 
powerful and gives it a distinct advantage over other nonholonomic motion planning 
algorithms. 

Another attractive feature of the surface integral algorithm that can be demon- 
strated using the two dimensional space robot is its ability to prove the reachability 
of specific nonholonomic systems. The reachability of the space robot can be proven 
by showing that there exists a rectangular surface in the Oi-O^ plane defined by the 
points {Oit, 0 iu.,O 2 i, 07 u) such that the equality in Eq.(22) can be satisfied for any arbi- 
trary value of 00 = ^ 0 / - ^od- Note that the initial values of 0i and 02 do not necessarily 
have to lie on the boundary of the rectangular surface. This follows from the dis- 
cussion of Chapter II.C.l. Also note that if the identity in Eq.(22) can be satisfied 
for some value of 0o by travelling along the boundary of the rectangle in the positive 
direction, then the same identity can be satisfied for -0o simply by travelling along 
the boundary in the negative direction. Finally, if the identity can be satisfied for 
some value of 0o by travelling once along the boundary of the rectangle, then the 
identity can be satisfied for the value n0o, n- 1,2, • ••, by travelling n times along the 
boundary in the same direction. Clearly, the reachability problem thus reduces to 
showing that the identity in Eq.(22) can be satisfied for any value of 0o e [0, e) where 
€ is some small positive number. Consider the following quantity from Eq.(24): 
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A 
a = 



1 1 

A B cos 02u A-\: B cos O 21 



( 25 ) 



If 02u and 021 are chosen in such a manner so as to ensure that q does not equal zero, 
Eq.(24) can be rewritten as follows: 



M Iona 



— ^lu — 



( 26 ) 



With this formulation, it is quite obvious that (0iu - 0u) can be chosen such that 
Eq.(26) is satisfied thus proving that Eq.(22) can be satisfied for any value of 0o € (0, e). 

A final feature of the surface integral algorithm that can best be illustrated with 
the space robot concerns the problem of repeatability. In Chapter II. C. 5., it was 
stated that the surface integral algorithm allowed for the calculation of trajectories 
needed to produce repeatable motion. In particular situations, a space robot may 
be expected to perform a repetitive task. In such a situation, the end effector of 
the robot as well as its configuration variables will all have to move along closed 
trajectories. If the joints of the robot shown in Fig. 5 move along closed trajectories, 
the dependent variables xo and yo will always move along closed trajectories because of 
the holonomic nature of the linear momentum constraints. The dependent variable 0o 
will however not move along a closed trajectory in the general case. If the net change 
in 00 were also to be zero as the joints moved along a closed rectangular path, then 
from Eq.(24) the necessary conditions that would have to be satisfied are 0i„ - 0u or 
cos^ 2 u = cos^ 2 i- The first condition leads to the trivial case where the first joint of the 
robot will have to be kept fixed. The second condition states that repeatability is 
assured as long as 02u + ^ 2 t = 2 n tt, n = 0, ±1, ±2, • • •. The examples considered thus far 
demonstrate that a significant amount of flexibility exists with regard to choosing the 
closed trajectories. Although the condition 02 u + O 2 i = 2mr, n — 0, ±1,±2, • • • will greatly 
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where Stake’s Theorem, in the simplified form of Eq.(ll), was applied to convert the 
line integrals into surface integrals. 5 is therefore the surface in the 0-a plane enclosed 
by the closed curve C. Specification of this surface as a rectangle with sides parallel 
to the 0 and q axis leads to 

Xf—Xd = —j / rcosa da = — — ^;)(sinQu — sin Qj) (.31) 

J Ctl J $i 

1‘CXyj, 

yf^yd= / r sin a do da = -r{0u - Oi){cosau - cos ai) (32) 

J Ctl J $i 

where 9i and denote the lower and upper extremities of 9 in the rectangular path, 
and at and denote the same for q. Eqs.(31) and (32) can be simplified by letting 
6 = a„ - Q( and a = 9^ -9i. With these substitutions, Eqs.(31) and (32) become 



Xf — Xd = —ra [sin(6 + q;) — sina;] 



(33) 



Vf - y<i= -ra [cos(6+ q;) - cosq;] 



Simplification through the use of trigonometric identities yields 



X f — Xd — — 2rocos(Q; + — ) sin - 
yj -yd= 2rosin(ai + -) sin - 



(34) 



( 35 : 



(36) 



To construct a closed loop path in the 9-a plane that will serve to converge the 
dependent variables from (xd,yd) to {x/,yf), one merely needs to choose q; and solve 
Eqs.(35) and (36) simultaneously for o and 6 to obtain 



b — 2 [—a; + arctan2(j// - yd,a:d - Xf)] , 0 < 6 < 47t 

{{xf - Xdf + (y/ 



a = 



(37) 

(38) 



2r sin(6/2) 

Since the solutions to the arctan2 function differ by an angle of 27 t, b in Eq.(37) 
can always be chosen to be a positive number subject to 6 < 47 t. Furthermore, Eq.(37) 
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was derived from Eqs.(35) and (36) with the assumption that osin(6/2) is a positive 
number. Thus, in Eq.(38), the positive square root of the numerator on the right hand 
side is always chosen rather than the negative. This may sometimes lead to negative 
values of a. In such situations, the path is constructed as though a were positive and 
then is traversed in the direction opposite to normal convention. A generic closed 
rectangular path PQRSP with sides of length a and 6 as well as the required initial 
path OP needed to converge the independent variables is shown in Fig. 10(a). In this 
figure, a( has been chosen to be equal to a/. 

At this point, it is worth noting that as the disk moves along the sides QR and 
SP of the rectangular path PQRSP in Fig. 10(a), the value of a must change in the 
absence of rolling. Since this might be difficult to achieve in practice, such as in 
the case of a unicyclist, the rectangular path PQRSP can be modified to the path 
PQMNP shown in Fig. 10(b). It is a simple matter to show that the surface integrals 
in Eqs.(29) and (30) will have the same value for each of these paths. As a result, 
the path PQMNP produces the same change in the values of the dependent variables 
X and y as the original path PQRSP. The path PQMNP requires a to change only 
when the disk is rolling and is therefore a more physically feasible path. 

Consider now a disk of radius r = 0.25 meters at an initial configuration of 
= (0.0, 0.0, 0.0, 0.0) meters, degrees. Suppose that the desired configura- 
tion of the disk is (i/,y/,^/,a/) = (1.0,1.0,180.0,30.0) meters, degrees. The independent 
variables 0 and a are first converged to their desired values using the straight line 
path OP shown in Fig. 11 (a). The values of the dependent variables x and y at the 
end of this path, obtained via computer simulation, are Xd = 0.20 meters and yd = 0.75 
meters as shown in Fig. 11(b). Choosing a rectangular path with a; = aj = 30.0 de- 
grees and solving for the values of a and b using Eqs.(37) and (38) results in o = 130.4 
degrees and b = 265.3 degrees. A slight modification to this path using a value of 
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3 = 45.0 degrees in order to allow the value of a to change only while the disk is 
rolling results in the closed path PQRSP, also shown in Fig. 11(a). Execution of this 
path results in the dependent variables evolving from (xa,yd) = (0.20,0 75) meters to 
= (10, 1.0) meters while the independent variables change but finally return to 
values of (^/,a/) = (180.0,30.0) degrees. Fig. 11(b) shows the actual path of the disk in 
the x-y plane. 

The above example illustrates the validity of the surface integral algorithm when 
applied to the rolling disk. However, consider Eq.(38) once again. Note that an 
algorithmic singularity will occur if 5 = 2mr, n = 0 , 1 , 2 , •• •. Substituting this value of 6 
into Eq.(37) reveals that the surface integral algorithm, as discussed thus far, breaks 
down if Q(, the lower value of a on the requisite closed trajectory, has value 

at — 3iTcta.n2 (yf — yd, Xd ~ Xf) — nn, n = 0. 1,2, •••, (39) 

As Stated in Chapter II. C. 3., the surface integral algorithm is equipped to handle 
such a case. In Chapter II.C.l, it was noted that the closed trajectory of the indepen- 
dent variables needed to converge the dependent variables could lie anywhere in the 
space of the independent variables. It does not have to pass through any particular 
configuration of the system. As a result, ai can be chosen arbitrarily and if by chance 

that choice results in the equality of Eq.(39) being satisfied, one merely needs to make 

) 

another choice. 

Once again, consider a disk with radius r = 0.25 meters and an initial configuration 
(xt,yt,0t,ai) = (0.0, 0.0, 0.0, 0.0) meters, degrees. This time, let the desired configuration 
of the disk be {xj,yj,9f,af) = (-0.4,1.0,180.0,22.5) meters, degrees. As before, the in- 
dependent variables are first converged to their desired values, this time along the 
path OT of Fig. 12(a). The values of the dependent variables (again obtained via com- 
puter simulation) evolve from (x.,?/,) = (0.0, 0.0) meters to (xd,yd) = (0.15,0.77) meters 
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as 0 and q traverse this path. If q; were chosen to be equal to q/ as before, Eq. 
(39) would be very nearly satisfied and the required value of a needed to converge 
the dependent variables would be inordinately large as evident from Eq.(38). As a 
result, a; is not chosen to be equal to a/ but is instead chosen (arbitrarily) as q< = 10.0 
degrees. Such a choice results in the current configuration of the system not lying 
on the closed trajectory needed to converge the dependent variables. The disk must 
therefore traverse the path segment TU of Fig. 12(a) in order to arrive at the start of 
the requisite closed trajectory. This motion results in the dependent variables evolv- 
ing from (xd,yd) - (0.15,0.77) meters to = (0.32, 1.33) meters. A check of Eq.(39) 

reveals that with at = 10.0 degrees, the disk is no longer near a singular configuration. 
As a result, Eqs.(37) and (38) can now be solved for a and 6 yielding values of a = 305.2 
degrees and 6 = 26.0 degrees. Note that the values of x'^ and y'^ were not considered 
when solving for a and b since the change in the values of the dependent variables 
[(x(( - Xd) and {y'd - yd)] in traversing the path segment TU will be negated when that 
same path segment is executed in reverse. The complete closed path TUVW XUT, 
shown in Fig. 12(a) and modified as before with a value of ;? = 45.0 degrees, results in 
the convergence of the dependent variables from their intermediate configuration of 
{xd,yd) = (0.15,0.77) meters to their final desired values of (x/,y/) = (-0.4, 1.0) meters. 
Because the path is closed in the 6-a plane, the independent variables return to their 
desired values of {9/, a/) = (180.0,22.5) degrees. Fig. 12(b) shows the actual path of the 
disk in the x-y plane. 

The two rolling disk motion planning problems described above once again demon- 
strate the validity of the surface integral algorithm. Additionally, in the process of 
showing that algorithmic singularities can be easily overcome, it was demonstrated 
that the closed path needed to converge the dependent variables can lie anywhere in 
the space of the independent variables. 
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IV. SUMMARY AND RECOMMENDATIONS 



In this thesis, an algorithm for calculating the coordinate trajectories required to 
drive a nonholonomic mechanical system from one point in its configuration space 
to another has been presented. The algorithm entails first driving the independent 
variables to their desired values. Closed trajectories of the independent variables 
are then executed in order to drive the dependent variables to their desired values. 
Stoke s Theorem is employed to convert the problem of finding an appropriate closed 
path in the space of the independent variables to one of finding a surface area in 
that same space such that the dependent variables converge to their desired values 
as the independent variables traverse along the boundary of this surface area. The 
algorithm is conceptually simple and applicable to a large class of nonholonomic me- 
chanical systems. The requisite closed trajectories are not restricted to any particular 
location in the space of the independent variables, the algorithm allows for motion 
planning in the presence of additional constraints, algorithmic singularities are easily 
overcome, and questions pertaining to the reachability and repeatability of the sys- 
tem are readily answered. Application of the algorithm to two simple nonholonomic 
mechanical systems, a planar space robot and a disk rolling without slipping on a flat 
surface, demonstrate the validity and utility of the algorithm. 

The application of this algorithm to other, more practical nonholonomic motion 
planning problems is a logical next step. An actual three dimensional space structure 
might be considered. Cyclic motions of the joints of a manipulator attached to the 
structure could be used to control the attitude of the structure itself. These cyclic 
motions could be planned using the surface integral approach. This method of con- 
trolling the structure would result in significant reductions in cost and weight since 
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the requirement for fuel consuming thrusters would be minimized. The algorithm 
might also be applied to the motion planning of a wheeled mobile robot or robotic 
hand with dextrous fingers. Additionally, it may even prove useful in controlling the 
orientation of certain underwater vehicles. In summary, the surface integral algo- 
rithm provides a new and useful approach to the motion planning of nonholonomic 
mechanical systems and offers a wide range of possibilities for its implementation. 
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between the coordinates themselves. 
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Fignie 1(b). A disk rolling without slipping on a flat surface is a nonholonomic 
mechanical system since the constraints of motion are represented by nonint- 
egrable relationships between the velocities of the system. 
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rigure 2(a). The rolling cli.sk can be driven from an initial configuralion of (x, y, 0, ex) 
to a desired configuration of ( x^j, y^j,0,a) by following the path AOB. 
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arrive at its desired configuration. 
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Figure 3 (a). Posilive direction of travel along the closed curve C in Stokes Tlieorem 
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Figure 3 (b). Positive direction of travel along tlie closed curve C in Green's Tlieoretn 




41 



produces a change in the dependent variable p by an amount Ap. I he initial 
configuration of the system, (I), lies on this closed trajectory. 
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Figure 4 (b). I’lie closed trajectory C in the independent variables x, y, and z 
produces a change in the dependent variable p by an amount Ap. The initial 
configuration of the system , (1), does not lie on this closed trajectory. 
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Figijxe 5. A wo-link manipulacor mounced on a space vehicle is described 
by chree generalized coordinates; 9^, 9 p 9 The center of mass of ±e 
space vehicle has the coordinates y,j. 
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Figure 6(a). The path segment OA followed by tlie closed trajecory ABCl^A con- 
verges all of the configuration variables of the space robot to their desired values 
when the closed trajectory is traversed three times. 
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Figure 6(b). Fvolution of the configuration variable.^ of the space robot with time 
when the path segment OA followed by three (rips about the closed trajectory 
ABCDA is executed. Points O, A, B, C, and D in this figure correspond to the 
same points in figure 6(a). 
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0| (degrees) >- 

Figure 7(a). Flie path segment OA followed by the closed trajectory AFI'GA 
converges all of the configuration variables of the space robot to their desired 
values when the closed trajectory is traversed three times, fhe closed trajectory 
was planned subject to the constraint 1 0 jl <90 degrees. 
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AEFGA is executed. I'he points O, A, E, E, and G in this figure correspond to the 
same points in figure 7(a). 
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0| (degrees) >► 

Figure 8(a). The path segment OA followed by the closed trajectory AHIJA 
converges all of the configuration variables of the space robot to their desired 
values when the closed trajectory is traversed six times. The closed trajectory 
was planned subject to the constraints l0j I < 90 degrees and ^^2^ “ degrees. 
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Figure 8(b). Evolution of the configuration variables of the space robot with 
time when the path .segment OA followed by six trips about the closed trajectory 
AH1.IA is executed. The points O, A, H. 1, and J correspond to the .same points 
in figure 8(a). 
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0| (degrees) 

Figure 9(a). The clo.sed Irajeclory OAKI.MO allows llie space robot to execute 
completely repeatable motion between the configuration described by poitU O 
and the configuration described by point L. 
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(ime when the closed trajectory OAKLMO is executed five times. 1'he points 
O, A, K, L, and M correspond to the same points in figure 9(a). 
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lengCh a and b needed (o converge ibe configuration variables of (he rolling disk to 
their desired values. In this figure, (X. has been chosen to beec|ual to (x... 
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require the angle a to change in tlie absence of rolling. 
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Figure 1 1(a). The path segment OP followed by the closed trajectory 
PQRSP converges all of the configuration variables of the rolling disk 
to their desired values. 
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Figure 1 1(b). The actual path of the di.sk in the x-y plane. Points (), P, 
R, S, and P correspond to the same points in figure 1 1(a). 



- a coordinates 
(in degrees) 

= ( 0.0, 0.0 ) a = 305.2 degrees 
= ( 1 80.0, 22.5 ) b = 26.0 degrees 
= ( 3 1 5.0, 1 0.0 ) P = 45.0 degrees , 
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Figure 12(a). I’he path segments OA and TU followed by the closed 
trajectory UVWXU and finally back along the path segment UT con- 
verges all of the configuration variables of the rolling disk to their 
desired values. The path .segments 'I'U and Ul' were added to avoid ai 
algorithmic singularity. 
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y (melcis) 

Figm e 12(b). Tlie actual path of the di.sk in the x-y plane. Points 
U, V, W, X, U, and T correspond to the same points in figure 12 
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